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(57) 摘要 

本 申请 公开 了 一 种 舵 机 ID 设置 方法 、 系 统 、 
设备 及 存储 介质 ,其 中 ,所 述 方法 包括 :接收 ID 设 
置 指令 ,控制 各 个 舵 机 进入 初始 化 状态 ;实时 获 
取 各 个 舵 机 受到 的 外 力 大 小 ;基于 舵 机 受到 的 外 
力 大 小 ,在 外 力 达 到 阔 值 且 持 续 时 间 达 到 预定 时 


接收 ID 设置 指令 ， 控 制 各 个 舵 机 进入 初 | /1 
始 化 状态 


实时 获取 各 个 舵 机 受到 的 外 力 大 小 


| 
基于 舵 机 受到 的 外 力 大 小 ， 在 外 力 达到 


I -es 十 启 dy4 人 人 4 Hi 
间 时 ,将 对 应 艇 机 的 攻 在 初始 ID 的 基础 上 增加 巴 阅 什 且 持 续 时 间 达 到 预定 时 间 时 ， 将 对 |/ 
设 的 数值 ,基于 同一 个 艇 机 ,在 舵 机 的 ID 基 于 初 应 艇 机 的 ID 在 初始 ID 的 基础 上 增加 预 设 
TD 的 基础 上 增加 预 设 的 数值 后 ,外 力 大 小 再 次 的 数值 
达到 靖 值 且 持 续 时间 达 到 预定 时 间 时 ,在 前 次 ID i 和 
y 有 、 | 、 > » 总 马 a t » [a 局 口 
的 基础 上 再 次 增加 预 设 的 数值 ;通过 本 申请 上 壕 ID 的 基础 上 增加 预 设 的 数值 后 ， 外 力 大 | 广 S4 
方案 ,无 须 拆 仓 舵 机 进行 ID 设置 ,可 以 快速 的 设 小 再 次 达到 阔 值 且 持 续 时 间 达 到 预定 时 
置 通 机 ID ,操作 方便 ,方便 用 户 自行 设置 能 机 ID。 间 时 ， 在 前 次 ID 的 基础 上 再 次 增加 预 设 


的 数值 
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1 .一 种 和 能 机 ID 设置 方法 ,其 特征 在 于 ,包括 : 

接收 ID 设置 指令 ,控制 各 个 舵 机 进入 初始 化 状态 ; 

实时 获取 各 个 能 机 受到 的 外 力 大 小 ; 

基于 能 机 受到 的 外 力 大 小 ,在 外 力 达 到 阀 值 且 持续 时 间 达 到 预定 时 间 时 ,将 对 应 舵 机 
的 ID 在 初始 ID 的 基础 上 增加 预 设 的 数值 ; 

基于 同一 个 和 通 机 ,在 舵 机 的 ID 基于 初始 ID 的 基础 上 增加 预 设 的 数值 后 ,外 力 大 小 再 次 
达到 阔 值 且 持 续 时 间 达 到 预定 时 间 时 ,在 前 次 ID 的 基础 上 再 次 增加 预 设 的 数值 。 

2. 根 据 权 利 要 求 1 所 述 的 舵 机 ID 设置 方法 ,其 特征 在 于 ,接收 ID 设置 指令 ,控制 各 个 稻 
机 进入 初始 化 状态 的 步 又 包括 : 

调节 各 个 能 机 的 位 置 以 及 相对 位 置 关系 。 

3. 根 据 权 利 要 求 1 所 述 的 舵 机 ID 设置 方法 ,其 特征 在 于 ,接收 ID 设置 指令 ,控制 各 个 能 
机 进入 初始 化 状态 的 步骤 之 前 还 包括 : 

预 设 一 初始 ID; 初始 ID 在 每 次 接收 到 ID 设置 指令 时 被 调用 。 

4. 根 据 权 利 要求 1 所 述 的 能 机 ID 设置 方法 ,其 特征 在 于 ,所 述 方法 还 包括 : 

在 舱 机 ID 发 生变 化 时 ,发 出 提示 。 

5 .一 种 能 机 ID 设置 系统 ,其 特征 在 于 ,包括 : 

初始 化 模块 ,用 于 接收 ID 设置 指令 ,控制 各 个 能 机 进入 初始 化 状态 ; 

外 力 获取 模块 ,用 于 实时 获取 各 个 能 机 受到 的 外 力 大 小 ; 

ID 设置 模块 ,用 于 基于 舵 机 受到 的 外 力 大 小 ,在 外 力 达 到 阔 值 且 持 续 时 间 达 到 预定 时 
间 时 ,将 对 应 舵 机 的 ID 在 初始 ID 的 基础 上 增加 预 设 的 数值 ; 

所 述 ID 设 置 模块 中 ,基于 同一 个 艇 机 ,在 艇 机 的 ID 基 于 初始 ID 的 基础 上 增加 预 设 的 数 
值 后 ,外 力 大 小 再 次 达到 阔 值 且 持 续 时 间 达 到 预定 时 间 时 ,在 前 次 ID 的 基础 上 再 次 增加 了 预 
设 的 数值 。 

6. 根 据 权 利 要 求 5 所 述 的 舵 机 ID 设置 系统 ,其 特征 在 于 ,所 述 初始 化 模块 包括 : 

调节 单元 ,用 于 调节 各 个 能 机 的 位 置 以 及 相对 位 置 关系 。 

7 .根据 权利 要 求 5 所 述 的 舵 机 ID 设 置 系统 ,其 特征 在 于 ,所 述 系统 还 包括 : 

预 设 模块 ,用 于 预 设 一 初始 ID; 初 始 ID 在 每 次 接收 到 ID 设置 指令 时 被 调用 。 

8 .根据 权利 要 求 5 所 述 的 舵 机 ID 设置 系统 ,其 特征 在 于 ,所 述 系统 还 包括 : 

提示 模块 ,用 于 在 舵 机 ID 发 生变 化 时 ,发 出 提示 。 

9 .一 种 舵 机 ID 设置 设备 ,其 特征 在 于 ,包括 存储 器 和 处 理 器 ,所 述 存储 器 存储 有 能 够 被 
处 理 器 加 载 并 执行 如 权利 要 求 1-4 任 一 所 述 的 舵 机 ID 设置 方法 的 计算 机 程序 。 

10 .一 种 存储 介质 ,其 特征 在 于 ,存储 有 能 够 被 处 理 器 加 载 并 执行 如 权利 要 求 1-4 任 一 
所 述 的 能 机 ID 设置 方法 的 计算 机 程序 。 


出 
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技术 领域 
[0001] ”本 申请 涉及 舵 机 领域 ,尤其 涉及 一 种 舵 机 ID 设 置 方法 、 系 统 、 设 备 及 存储 介质 。 


背景 技术 

[0002] ”能 机 即 机 器 人 的 关节 ,可 以 通过 控制 每 个 能 机 的 角度 ,来 控制 机 器 人 做 不 同 的 动 
作 。 比 如 现 有 的 仿生 机 械 手 侣 机 器 人 ,有 多 个 能 机 控制 手臂 做 出 各 种 动作 。 每 个 能 机 内 部 都 
有 一 个 微 控制 单元 , 舵 机 与 舵 机 之 间 是 串联 在 一 起 ,最 终 连 在 主 控 板 上 。 舵 机 与 舵 机 之 间 以 
总 线 拓 扑 结构 相连 接 。 采 用 一 主 多 从 的 设计 模式 ,只 有 主机 发 送 控制 命令 ,或 者 查询 命令 ， 
从 机 才能 做 出 相应 动作 ,或 者 返回 数据 ,避免 了 多 个 从 机 如 果 同 时 主动 发 送 数据 导致 的 总 
线 神 突 。 主 控 板 控制 不 同位 置 的 能 机 转动 到 不 同 的 角度 ,就 需要 按照 预先 设 定好 的 协议 进 
行 通信 控制 ,所 以 舵 机 之 间 必 须要 有 不 同 的 I1D 号 , 主 控 板 才能 识别 到 相应 的 舵 机 ,并 控制 。 
[0003] “” 现 有 最 传统 也 是 最 可 靠 的 ID 设置 方式 是 :用 专用 舵 机 ID 设置 设备 ,与 舵 机 相连 , 通 
过 发 送 更 改 ID 指令 进行 ID 设置 .比如 要 生产 机 械 壁 (有 6 个 关 市 ) ,那么 事先 就 要 设置 好 6 
种 ID 号 的 舵 机 ,并 分 别 装 入 收纳 箱 区 分 开 , 然 后 生产 人 员 在 生产 的 时 候 依次 安装 上 相应 ID 
号 的 舵 机 进行 组 半生 产 。 

[0004] ”在 研发 测试 阶段 ,有 时 候 要 极限 测试 机 器 人 的 性 能 ,所 以 很 容易 损坏 一 些 舵 机 ,更 
换 舵 机 设置 ID 的 情况 时 有 发 生 ，ID 设 错 也 经 常 发 生 . 对 于 安装 在 机 器 人 机 体内 部 的 舵 机 ， 
一 但 ID 设 错 或 者 重复 ,必须 要 拆 掉 外 壳 重 新 连 上 舵 机 ID 设置 设备 设置 ,严重 影响 研发 测试 
的 效率 。 

[0005] ”在 调试 阶段 ,如 果 发 现 茶 个 或 茶几 个 舵 机 没 反应 ,或 者 同步 动作 ,原因 可 能 是 ID 号 
设 错 或 重复 设置 ,需要 重新 设置 ID ,就 需要 重新 连 上 此 机 ID 设置 设备 设置 ,要 重新 插 拔 线 ， 
经 过 一 系列 繁琐 操作 才能 设置 好 。 如 果 有 的 艇 机 在 机 体内 部 ,就 需要 拆 掉 机 体 去 设置 ,操作 
起 来 更 麻烦 。 
[0006] ”在 售后 维修 方面 ,如 果 客 户 的 茶 个 关节 坏 了 需要 更 换 , 反 馈 个 给 维护 人 员 时 ,需要 
告知 坏 的 是 几 号 能 机 ,然后 维护 人 员 要 设置 好 ID 后 才能 返 给 客户 ,如 果 坏 了 好 几 个 能 机 ,在 
返修 过 程 中 就 很 容易 出 错 。 

[0007] ”因此 ,如 何 快速 实现 能 机 的 巧 设置 是 个 吗 符 解决 的 问题 。 


一 


发 明 内 容 
[0008] ”本 申请 的 目的 是 实现 快速 设置 舵 机 的 ID。 
[0009] ”本 申请 的 上 述 技 术 目 的 是 通过 以 下 技术 方案 得 以 实现 的 : 
本 申请 第 一 方面 ,公开 了 一 种 舵 机 ID 设置 方法 ,其 中 ,包括 : 
接收 ID 设置 指令 ,控制 各 个 舵 机 进入 初始 化 状态 ; 
实时 获取 各 个 能 机 受到 的 外 力 大 小 ; 
基于 能 机 受到 的 外 力 大 小 ,在 外 力 达 到 闪 值 且 持 续 时 间 达 到 预定 时 间 时 ,将 对 应 
能 机 的 ID 在 初始 ID 的 基础 上 增加 预 设 的 数值 ; 
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基于 同一 个 能 机 ,在 舵 机 的 ID 基于 初始 ID 的 基础 上 增加 预 设 的 数值 后 ,外力 大 小 
再 次 达到 阔 值 县 持续 时 间 达 到 预定 时 间 时 ,在 前 次 ID 的 基础 上 再 次 增加 预 设 的 数值 。 
[0010] “本 申请 上 述 方案 ,通过 基于 每 个 能 机 的 外 力 大 小 的 判断 ,来 实现 和 通 机 ID 的 设置 , 简 
化 了 能 机 ID 设置 操作 ,操作 方便 快捷 。 
[0011] 可 选 的 ,所 述 的 能 机 ID 设置 方法 ,其 中 ,接收 ID 设置 指令 ,控制 各 个 舵 机 进入 初始 
化 状态 的 步骤 包括 : 

调节 各 个 舵 机 的 位 置 以 及 相对 位 置 关 系 。 
[0012] ”本 申请 上 述 方 案 , 通 过 对 各 个 舵 机 的 位 置 以 及 相对 位 置 进行 调节 ,对 ~ 航 机 进行 初 
始 化 ,便于 对 外 力 进行 感应 ,从 而 判断 ID 是 否 需 要 变化 。 
[0013] “可 选 的 ,所 述 的 能 机 ID 设置 方法 ,其 中 ,接收 ID 设置 指令 ,控制 各 个 舵 机 进入 初始 
化 状态 的 步 又 之 前 还 包括 : 

预 设 一 初始 ID; 初始 ID 在 每 次 接收 到 ID 设置 指令 时 被 调用 。 
[0014] “本 申请 上 述 方案 ,通过 预 设 初始 ID ,在 每 次 ID 设置 时 ,调用 初始 ID ,在 初始 ID 基础 
上 增加 数值 ,实现 ID 的 变化 ,对 能 机 进行 ID 设置 。 
[0015] ”可 选 的 ,所 述 的 艇 机 ID 设 置 方 法 ,其 中 ,基于 艇 机 受到 的 外 力 大 小 ,在 外 力 达 到 立 
值 且 持 续 时 间 达 到 预定 时 间 时 ,将 对 应 舵 机 的 了 在 初始 ID 的 基础 上 增加 预 设 的 数值 的 步 又 
还 包括 : 

可 选 的 ,所 述 的 能 机 ID 设置 方法 ,其 中 ,所 述 方法 还 包括 : 

在 舵 机 ID 发 生变 化 时 ,发 出 提示 。 
[0016] “本 申请 上 述 技术 方案 ,在 舵 机 ID 发 生变 化 时 发 出 提示 , 便于 用 户 知 悉 当 次 ID 设置 
操作 已 生效 ,可 以 对 下 一 个 舵 机 进行 ID 设置 ,或 再 次 改变 当前 舵 机 的 ID。 
[0017] ”本 申请 另 一 方面 ,公开 了 一 种 能 机 ID 设置 系统 ,其 中 ,包括 ; 

初始 化 模块 ,用 于 接收 ID 设置 指令 ,控制 各 个 舵 机 进入 初始 化 状态 ; 

外 力 获 取 模 块 ,用 于 实时 获取 各 个 舵 机 受到 的 外 力 大 小 ; 

ID 设置 模块 ,用 于 基于 舵 机 受到 的 外 力 大 小 ,在 外 力 达 到 阔 值 旦 持续 时 间 达 到 预 
定时 间 时 ,将 对 应 能 机 的 ID 在 初始 ID 的 基础 上 增加 预 设 的 数值 ; 

所 述 ID 设置 模块 中 ,基于 同一 个 能 机 ,在 舵 机 的 ID 基于 初始 ID 的 基础 上 增加 预 设 
的 数值 后 ,外 力 大 小 再 次 达到 阐 值 且 持 续 时 间 达 到 预定 时 间 时 ,在 前 次 ID 的 基础 上 再 次 增 
加 预 设 的 数值 。 
[0018] “本 申请 上 述 方案 ,通过 基于 每 个 能 机 的 外 力 大 小 的 判断 ,来 实现 能 机 ID 的 设置 , 简 
化 了 能 机 ID 设置 操作 ,操作 方便 快捷 。 
[0019] ”可 选 的 ,所 述 的 舵 机 ID 设 置 系统 , 其 中 ,所 述 初始 化 模块 包括 : 

调节 单元 ,用 于 调节 各 个 能 机 的 位 置 以 及 相对 位 置 关 系 。 
[0020] ”本 申请 上 述 方案 ,通过 对 各 个 舵 机 的 位 置 以 及 相对 位 置 进行 调节 ,对 舵 机 进行 初 
始 化 ,便于 对 外 力 进行 感应 ,从 而 判断 ID 是 否 需 要 变化 。 
[0021] ”可 选 的 ,所 述 的 舵 机 ID 设 置 系统 ,其 中 ,所 述 系统 还 包括 : 

预 设 模块 ,用 于 预 设 一 初始 ID; 初始 ID 在 每 次 接收 到 ID 设置 指令 时 被 调用 。 
[0022] “本 申请 上 述 方案 ,通过 预 设 初始 ID ,在 每 次 ID 设置 时 ,调用 初始 ID ,在 初始 ID 基础 
上 增加 数值 ,实现 ID 的 变化 ,对 舵 机 进行 ID 设置 。 
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[0023] ”可 选 的 ,所 述 的 舵 机 ID 设置 系统 ,其 中 ,所 述 系统 还 包括 : 

提示 模块 ,用 于 在 舵 机 ID 发 生变 化 时 ,发 出 提示 。 
[0024] “本 申请 上 述 技术 方案 ,在 舵 机 ID 发 生变 化 时 发 出 提示 , 便于 用 户 知 悉 当 次 ID 设置 
操作 已 生效 ,可 以 对 下 一 个 舵 机 进行 ID 设置 ,或 再 次 改变 当前 舵 机 的 ID。 
[0025] “本 申请 另 一 方面 ,公开 了 一 种 舵 机 ID 设置 设备 ,其 中 ,包括 存储 器 和 处 理 器 ,所 述 
存储 器 存储 有 能 够 被 处 理 器 加 载 并 执行 如 上 所 述 的 能 机 ID 设置 方法 的 计算 机 程序 。 
[0026] “本 申请 另 一 方面 ,公开 了 一 种 存储 介质 ,其 中 ,存储 有 能 够 被 处 理 器 加 载 并 执行 如 
权利 要 求 所 述 的 能 机 ID 设置 方法 的 计算 机 程序 。 
[0027] ” 综 上 所 述 ,本 申请 包括 以 下 至 少 一 种 有 益 技术 效果 ; 

通过 获取 每 个 艇 机 的 外 力 大 小 ,在 外 力 大 小 达到 阔 值 且 持 续 时 间 达 到 预定 时 间 ， 
则 对 相应 的 能 机 ,在 初始 ID 基础 上 增加 预定 数值 , 舵 机 ID 设置 操作 简便 。 
[0028] ”通过 预 设 初始 ID ,在 每 次 能 机 ID 设置 时 调用 ,便于 知悉 变化 后 的 ID 数值 ,保证 ID 设 
置 的 准确 性 。 
[0029] ”在 舵 机 ID 发 生变 化 时 发 出 提示 ,便于 用 户 知 悉 舵 机 ID 的 变化 ,可 以 对 另外 的 能 机 
进行 ID 设置 或 再 次 更 改 当 前 能 机 的 ID。 


附 图 说 明 

[0030] ”图 1 是 本 申请 所 述 舵 机 ID 设 置 方法 的 步 又 流程 图 。 
[0031] ”图 2 是 本 申请 实施 例 ,能 机 的 角度 控制 的 系统 示意 图 。 
[0032] ”图 3 是 本 申请 实施 例 ,用户 设 定 角度 与 采集 角度 的 差 值 和 控制 力矩 的 关系 示意 图 。 


具体 实施 方式 
[0033] ”以 下 结合 附 图 对 本 申请 作 进一步 详细 说 明 。 
[0034] ” 现 有 技术 中 ,一 般 的 一 套 机 器 人 (比如 机 械 辟 ) 航 机 的 ID 设 置 从 1 开始 按 顺 序 递增 
设置 ,比如 机 械 臂 有 6 个 舵 机 ,那么 这 6 个 鹏 机 在 安装 前 就 会 设置 好 ID1~6 ,然后 相应 位 置 安 
装 相应 ID 号 的 舵 机 ,并 且 不 能 超出 预先 设 定 的 ID 范围 不 能 颠倒 、 不 能 相同 。 
[0035] ”如 果 超 出 ID 范围 ,就 不 能 控制 ,因为 机 械 臂 研发 设计 时 ,程序 内 部 就 已 经 固定 好 了 
相应 位 置 的 ID 号 。 如 果 颠 倒 , 就 会 出 现 控制 紊乱 。 如 果 相 同 ,那么 相同 ID 号 的 舵 机 就 会 同时 
动作 ,并 且 在 读 取 该 世 号 能 机 的 内 部 信息 时 ,那么 相同 ID 号 的 舵 机 就 会 同时 返回 数据 ,这 样 
会 造成 总 线 冲 突 , 导致 读 取 信息 失败 。 
[0036] “所 以 对 于 用 总 线 型 能 机 设计 生产 的 机 器 人 ,在 研发 测试 ,生产 调试 以 及 售后 维修 
方面 ,各 个 舵 机 (关节 ) 的 ID 设置 其 实 是 至 关 重 要 的 。 
[0037] ”背景 技术 中 提 到 了 ,在 生产 研发 以 及 测试 使 用 的 各 个 阶段 ,能 机 的 ID 出 错 , 需 要 重 
新 设置 , 现 有 的 设置 方法 ,操作 繁琐 ,影响 测试 或 使 用 ,因此 基于 上 述 问题 ,本 申请 公开 一 种 
舵 机 ID 设置 方法 ,解决 以 上 这 些 在 能 机 ID 错误 , 舵 机 ID 重复 时 ,不必 拆 线 , 拆 壳 去 专门 连接 
能 机 ID 设置 设备 去 设置 .具体 的 ,参阅 图 1 ,为 所 述 方法 的 步骤 流程 图 ,所 述 能 机 ID 设置 方法 
包括 : 

S1 .接收 也 设置 指令 ,控制 各 个 舵 机 进入 初始 化 状态 ; 

S2. 实 时 获取 各 个 舵 机 受到 的 外 力 大 小 ; 
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S3. 基 于 ~ 舵 机 受到 的 外 力 大 小 ,在 外 力 达 到 阔 值 且 持 续 时 间 达 到 预定 时 间 时 ,将 对 
应 艇 机 的 ID 在 初始 ID 的 基础 上 增加 预 设 的 数值 ; 

S4. 基 于 同一 个 能 机 ,在 艇 机 的 ID 基于 初始 ID 的 基础 上 增加 预 设 的 数值 后 ,外 力 大 
小 再 次 达到 立 值 且 持 续 时 间 达 到 预定 时 间 时 ,在 前 次 ID 的 基础 上 再 次 增加 预 设 的 数值 。 
[0038] “本 申请 实施 例 中 ,在 具体 实施 时 ,用 户 需要 设置 能 机 的 ID ,首先 要 发 送 一 个 ID 设置 
的 指令 ,在 实际 应 用 中 ,可 以 是 在 机 器 人 本 体 上 设置 一 个 快捷 按键 键 ,用 户 点 击 快捷 按键 ， 
一 键 启动 快速 设置 ID 模式 ,或 者 也 可 以 是 用 户 的 手机 在 装 入 软件 后 ,通过 软件 界面 上 的 虚 
拟 控制 按钮 ,发 送 ID 设 置 指令 给 机 器 人 的 主 控 板 ,机 器 人 的 主 控 板 控制 各 个 能 机 进入 初始 
化 状态 。( 初 始 化 状态 是 指 进入 舵 机 的 ID 设置 的 初始 化 , 舵 机 处 于 ID 待 设 置 状 态 ,并 非 是 回 
到 最 初 的 位 置 或 形态 ) ,多 个 能 机 进入 初始 化 状态 后 ,为 了 实现 能 机 的 ID 设置 ,需要 给 相应 
的 能 机 一 个 指令 ,本 申请 通过 采用 给 与 能 机 施加 外 力 的 方式 ,各 个 能 机 实时 获取 所 受到 的 
外 力 大 小 ,在 外 力 大 小 达到 阔 值 且 持 续 时 间 达 到 预定 时 间 时 ,就 说 明 ,对 应 的 艇 机 需要 改变 
ID ,此 时 ,将 对 应 艇 机 的 ID 在 初始 ID 的 基础 上 ,增加 一 预 设 的 数值 ,从 而 完成 一 次 舵 机 的 ID 
设置 。 
[0039] ”本 申请 实施 例 中 ,不 同 的 舵 机 , 锁 力 不 同 ,在 初始 化 状态 下 , 艇 机 由 于 锁 力 作用 , 需 
要 很 大 的 力气 ,才能 狂 动能 机 转动 ,依靠 这 一 特性 ,一 方面 ,为 了 避免 误 操作 ,所 以 施加 的 外 
力 不 可 过 小 ,同时 ,施加 的 外 力也 不 能 过 大 ,考虑 到 不 同 的 用 户 群体 ,用 力 过 大 会 让 用 户 感 
到 不 适 。 而 即使 外 力 达 到 了 触发 设置 ID 的 值 ,如 果 持 续 时 间 较 短 , 仍 然 可 能 是 用 户 误 操 作 的 
情况 ,所 以 ,本 申请 实施 例 中 ,可 以 设 定 一 阔 值 ,在 艇 机 受到 的 外 力 大 小 达到 阐 值 且 持 续 时 
间 达 到 预定 时 间 时 , 才 认 定 对 应 的 能 机 的 ID 需要 调整 , 则 在 初始 ID 的 基础 上 增加 预 设 的 数 
值 , 实 现 和 能 机 ID 的 设置 ,考虑 到 一 般 情况 下 ,机 器 人 的 能 机 个 数 不 是 特别 多 ,所 以 预 设 的 数 
值 一 般 为 1 ,也 就 是 触发 一 次 条 件 ,在 初始 ID 的 基础 上 +1, 例如 初始 ID 为 1 的 话 , 舵 机 触发 一 
次 ID 设 置 , 则 艇 机 的 ID 变 为 初始 ID1+ 预 设 值 1 ,也 就 是 舵 机 ID 设 置 为 2。 对 不 同 的 舵 机 施加 外 
力 , 从 而 对 不 同 的 舵 机 进行 ID 调整 ,本 申请 实施 例 中 ,初始 ID 可 以 为 设置 ID 时 的 舵 机 ID ,也 
可 以 为 预 设 的 初始 ID。 
[0040] ”本 申请 实施 例 中 ,在 完成 了 一 次 舵 机 ID 设置 后 ,可 以 进行 其 他 舵 机 的 ID 设置 ,也 可 
以 再 次 更 改 当前 舵 机 的 ID ,在 更 改 一 次 舵 机 ID 后 ,再 次 更 改 舵 机 的 ID 时 ,在 触发 指令 后 , 稻 
机 的 也 优选 在 前 次 的 ID 基础 上 增加 预 设 的 数值 ,比如 前 次 ID 设置 为 1+1=2, 那 么 再 次 触发 调 
整 指令 时 , ID 设置 为 2+1=3, 因 此 ,可 以 对 同一 个 艇 机 进行 连续 设置 .当然 ,如 果 前 一 次 的 能 
机 ID 设置 完成 后 ,更 换 了 能 机 后 ,再 对 前 一 次 的 能 机 进行 ID 设置 , 则 不 保留 前 次 ID , 而 改 为 
在 初始 ID 基础 上 增加 预 设 的 数值 ,只 有 连续 调整 , 才 会 进行 亚 加 。 
[0041] ”前述 方案 提 到 了 ,用 户 可 以 通过 一 键 启动 等 方式 ,发送 能 机 ID 设置 指令 ,机 器 人 控 
制 多 个 舵 机 进入 初始 化 状态 ,具体 的 ,所 述 的 能 机 ID 设置 方法 ,其 中 ,接收 ID 设置 指令 , 控 表 
各 个 舵 机 进入 初始 化 状态 的 步骤 包括 : 

调节 各 个 舵 机 的 位 置 以 及 相对 位 置 关系 。 
[0042] ”本 申请 实施 例 中 ,控制 能 机 进入 初始 化 状态 是 为 了 便于 进行 ID 设置 ,也 就 是 便于 
对 舵 机 施加 外 力 , 有 具体 的 , 当 舵 机 进入 ID 设置 模式 时 ,调节 各 个 舵 机 的 位 置 以 及 相对 位 置 关 
系 ,前 述 方案 提 到 了 ,初始 化 状态 是 ID 设置 的 初始 化 状态 ,不 是 位 置 和 形态 的 初始 化 ,用 户 
也 可 设置 初始 化 状态 为 位 置 和 形态 的 初始 化 ,例如 ,初始 化 状态 为 ,各 个 舵 机 都 竖 直 设 置 ， 
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便于 施加 外 力 , 当 然 , 也 可 以 相 邻 的 艇 机 有 一 定 的 角度 ,或 者 是 在 收 到 ID 设置 指令 时 ,保持 
当时 的 位 置 状 态 。 
[0043] ”前 述 方案 提 到 了 ,在 艇 机 受到 的 外 力 达 到 闵 值 且 持 续 时 间 达 到 预定 时 间 时 ,对 应 
的 能 机 ID 在 初始 ID 基础 上 增加 预 设 值 , 其 中 ,初始 ID 可 以 是 原 有 的 能 机 ID ,也 可 以 用 户 自行 
设 定 ,本 申请 实施 例 中 ,为 了 便于 计数 ,优选 初始 ID 为 用 户 预 设 ,其 中 ,接收 ID 设置 指令 , 控 
制 各 个 和 能 机 进入 初始 化 状态 的 步骤 之 前 还 包括 : 

预 设 一 初始 ID; 初始 ID 在 每 次 接收 到 ID 设置 指令 时 被 调用 。 
[0044] ”本 申请 实施 例 中 ,考虑 到 在 具体 实施 时 ,可 能 存在 默认 的 舵 机 ,也 就 是 固定 设置 的 
能 机 , 舵 机 ID 固定 ,不 能 改变 ,例如 有 5 个 舵 机 的 ID 固定 设置 了 ,为 1,2,3,4,5, 那 么 后 续 的 能 
机 则 从 6 开始 设置 ,本 申请 实施 例 中 ,优选 设 定 艇 机 的 ID 是 连续 的 ,当然 跳跃 的 ID 也 可 以 ,只 
是 会 增加 设置 的 工作 量 ,也 会 容易 出 错 , 本 申请 较 佳 实施 例 中 ,在 每 次 舵 机 受到 的 外 力 达 到 
闵 值 且 持 续 时 间 达 到 预 设 时 间 时 ,在 初始 ID 基础 上 增加 1, 如 果 没 有 默认 的 舵 机 ,那么 可 以 
将 初始 ID 设 为 0 ,并 且 每 次 舵 机 ID 设置 时 ,调用 初始 ID ,也 就 是 说 ,不 同 的 舵 机 ,在 进入 能 机 
ID 设置 时 ,都 从 初始 ID 开始 ,确保 ID 设置 的 准确 性 。 
[0045] 《前述 方案 提 到 了 ,在 能 机 受到 的 外 力 达 到 阔 值 且 持 续 时 间 达 到 预 设 值 时 , 舵 机 的 
ID 在 初始 ID 基础 上 增加 预 设 的 数值 ,在 具体 实施 时 ,用户 如 何 知悉 能 机 的 ID 发 生 改变 了 呢 ， 
因此 ,基于 上 述 问题 ,本 申请 实施 例 中 ,所 述 的 能 机 ID 设置 方法 ,其 中 ,所 述 方法 还 包括 ; 

在 舵 机 ID 发 生变 化 时 ,发 出 提示 。 
[0046] “本 申请 实施 例 中 ,在 能 机 ID 发 生变 化 时 ,会 发 出 提示 ,可 以 是 指示 灯 闪 一 次 ,也 可 
以 是 蜂 鸣 器 响 一 次 ,也 可 以 是 多 种 提示 的 组 合 ,当然 了 ,本 申请 中 ,在 具体 实施 时 ,还 可 以 设 
置 计 数 器 ,进行 计数 ,当然 了 ,计数 器 是 基于 同一 艇 机 的 ID 设置 ,在 更 换 舵 机 时 ,需要 手动 清 
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[0047] ”以 下 结合 示例 进行 说 明 ,假设 现 有 一 台 机 械 辟 的 所 有 了 骨 机 的 ID 号 不 知道 是 多 少 ， 
可 能 有 不 在 1~6 范 围 内 的 ,可 能 有 重复 1D 号 的 。 

[0048] ”首先 ,在 舵 机 控制 协议 里 面 已 经 规定 了 舵 机 的 1D 号 范围 为 1~N,N 为 一 固定 数值 , 假 
定 为 253, 所 有 主 控 板 能 通过 相应 的 世 号 控制 相应 的 能 机 。 主 控 板 与 和 能 机 之 间 的 控制 协议 的 
数据 包 格式 ,包括 例如 : 帧 头 .ID 号 数据 长 度 . 指 令 、 参 数 、 校 验 和 ,如 主 控 板 要 控制 3 号 的 能 
机 转动 30 度 ,那么 在 发 送 的 数据 包 里 面 只 要 将 ID 号 "设置 为 3， 指 令 设置 角度 控制 指令 ， 
“参数 "设置 带 有 具体 角度 信息 的 值 即 可 控制 3 号 能 机 转动 .因为 所 有 舵 机 都 是 连 在 一 根 总 
线 上 的 ,所 以 其 它 艇 机 也 都 会 收 到 上 述 指令 ,但 是 每 个 舵 机 会 比 对 自己 的 1D 号 ,发 现 不 匹配 
就 会 把 该 数据 丢弃 。 

[0049] ”协议 规定 ,当主 控 板 发 送 的 数据 包 的 “ID 号 ”为 254 时 ,代表 广播 群 控 指 令 , 当 总 线 
上 的 所 有 舵 机 收 到 此 ID 号 的 指令 后 ,不 会 比 对 自己 的 ID 号 ,立马 做 出 相应 指令 的 动作 。 
[0050] ”增加 一 条 让 能 机 进入 ID 设置 模式 的 指令 ,方便 快速 设置 也 号 ,该 指令 值 为 50( 只 
要 跟 现 有 的 其 它 功 能 指令 值 不 重复 即 可 ) , 主 控 板 上 有 一 个 按键 ,用 户 按 下 此 按键 ,开始 发 
送 ID 设置 模式 的 指令 ,由 于 不 知道 连接 的 能 机 号 是 多 少 ,所 以 数据 包 中 的 “ID 号 ”为 254, 即 
让 所 有 连 在 当前 总 线 上 的 能 机 进入 ID 设置 状态 ,随时 待命 设置 ID, 舵 机 收 到 此 命令 后 会 自 
动 运动 到 初始 角度 状态 ,并且 主 控 板 上 有 一 个 蜂 鸣 器 会 滴 的 响 一 声 , 有 一 个 LED 指 示 灯 会 
从 常 亮 状态 进入 闪烁 状态 ,提示 已 经 进入 ID 设置 模式 ， 
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此 时 用 户 手动 去 斑 动 想 要 设置 的 舵 机 ,由 于 上 一 步 舵 机 已 经 运动 到 了 初始 位 置 ， 
固定 在 那个 位 置 ,并 且 能 机 的 锁 力 还 是 很 大 的 ,比如 机 械 臂 的 能 机 扭力 可 以 达到 21kg“。cm。 
也 就 是 说 能 机 在 锁 力 的 情况 下 ,要 想 用 外 力 玫 动能 机 转动 ,需要 用 21kg。cm 的 力 才能 大 的 
动用 户 施加 的 力 越 大 , 舵 机 自身 对 抗 的 力也 会 越 大 ,对 抗力 与 最 大 力矩 的 比率 , 舵 机 内 部 
是 可 以 检测 计算 得 到 的 , 称 这 个 比率 为 “对 抗 比率 ”。 

[0051] ”通过 实验 数据 发 现 :只 有 这 个 对 抗 比率 大 于 25% 时 , 才 是 大 众 用 户 用 的 一 个 比较 明 
显 的 力 去 猎 动 达到 的 , 即 没有 非常 的 用 力 , 让 用 户 感到 不 适 。 也 不 是 用 很 小 的 力 就 能 达到 这 
个 比率 的 ,这 样 可 以 消除 干扰 。 

[0052] ”再 增加 一 条 指令 ,该 “指令 ” 值 为 51 (只 要 跟 现 有 的 其 它 功能 指令 值 不 重复 即 可 ) ， 
日 舵 机 返回 给 主 控 板 的 指令 。 用 户 璇 动 想 要 设置 的 舵 机 , 当 艇 机 检测 到 对 抗 比率 大 于 25%， 
并 坚持 2 秒 以 上 ,然后 松手 停止 广 动 为 一 个 完整 周期 .如 果 满 足 这 个 完整 周期 就 会 主动 发 送 
一 次 该 指令 给 主 控 板 。 当 然 其 它 舵 机 也 会 收 到 该 指令 ,但 是 舵 机 对 该 指令 不 做 任何 反应 。 
[0053] ”能 机 程序 内 部 有 一 个 “临时 ID” 的 变量 ,默认 值 为 0 每 次 开机 都 为 0, 每 次 收 到 " 进 
入 ID 设置 模式 ”的 指令 后 也 会 重新 置 0) 当 舵 机 发 送 上 一 步 的 指令 后 ,该 变量 会 自 增 1 ,并 且 
将 此 临时 ID 设 置 为 自己 的 ID, 此 时 主 控 板 也 接收 到 了 该 舵 机 发 来 的 指令 , 主 控 板 会 控制 自 
身 的 蜂 鸣 器 “ 滴 ” 一 声 , 重 复 前 述 壬 动 舵 机 的 操作 ,用 户 会 持续 听 到 入 立 ” 声 ,并 记 住 听 到 “ 滴 ” 
声 的 次 数 , 该 次 数 就 代表 了 要 设置 舵 机 的 1D 号 ,一 个 机 械 辟 6 个 舵 机 ,只 要 依次 奢 动 ,并 依次 
听 到 1~6 次 即 设置 好 全 部 艇 机 的 ID 写 。 

[0054] ”退出 ID 设 置 模式 。 有 2 种 方式 :第 一 种 ,重新 关机 开机 即 可 。 第 三 种 , 主 控 板 发 送 一 
条 角度 控制 的 指令 , 租 机 收 到 该 指令 后 会 自动 退出 ID 设 置 模式 。 同 时 主 控 板 的 LED 指 示 灯 也 
由 闪烁 状态 进入 常 亮 状态 。 

[0055] ”本 申请 中 , 航 机 的 角度 控制 是 一 个 闭环 的 控制 系统 ,其 中 ,参阅 图 2, 为 所 述 系统 的 
结构 框图 ,控制 器 就 是 舵 机 内 部 的 控制 芯片, 执行 器 就 是 电机 驱动 和 齿轮 传动 ,被 控 对 象 就 
是 角度 输出 ,反馈 环节 就 是 角度 采集 。 比 较 器 就 是 拿 用 户 设 定 的 角度 和 反馈 环节 采集 的 角 
度 进 行 比较 ,如 果 比 较 用 户 设 定 的 角度 还 未 到 达 采 集 的 角度 ,那么 就 控制 电机 继续 转动 ,以 
达到 设 定 的 角度 如果 比较 用 户 设 定 的 角度 已 经 超过 采集 的 角度 ,那么 就 控制 电机 反 向 转 
动 ,以 回 退 到 设 定 的 角度 。 这 里 比较 器 比较 ,得 到 的 用 户 设 定 角度 与 采集 角度 的 差 值 ,这 个 
差 值 与 控制 力矩 的 输出 大 小 是 成 正比 的 ,关系 示意 图 如 图 3 所 示 , 由 此 可 以 看 出 舵 机 内 部 是 
一 个 不 断 比较 角度 差 值 ,不断 调整 角度 的 过 程 ,直到 调整 到 指定 的 角度 ,也 就 是 差 值 为 0 时 ， 
力矩 也 为 0. 所 以 用 户 用 力 璇 动 舵 机 时 , 随 着 于 动 的 角度 离 设 定 角度 差 值 的 绝对 值 越 大 和 骨 机 
自动 计算 给 出 的 力矩 绝对 值 也 越 大 ,用 户 感受 到 的 对 抗力 也 越 大 , 当 力 矩 比率 超过 实验 经 
验 值 25% 时 ,如 果 舵 机 进入 ID 设置 模式 ,此 时 就 是 ID 设置 过 程 中 一 个 期 望 的 状态 点 。 

[0056] ”本 申请 另 一 实施 例 , 公 开 了 一 种 艇 机 ID 设置 系统 ,其 中 ,包括 ; 

初始 化 模块 ,用 于 接收 ID 设置 指令 ,控制 各 个 舵 机 进入 初始 化 状态 ; 

外 力 获 取 模 块 ,用 于 实时 获取 各 个 舵 机 受到 的 外 力 大 小 ; 

ID 设置 模块 ,用 于 基于 舵 机 受到 的 外 力 大 小 ,在 外 力 达 到 阔 值 旦 持续 时 间 达 到 预 
定时 间 时 ,将 对 应 能 机 的 ID 在 初始 ID 的 基础 上 增加 预 设 的 数值 ; 

所 述 ID 设置 模块 中 ,基于 同一 个 能 机 ,在 舵 机 的 ID 基于 初始 ID 的 基础 上 增加 预 设 
的 数值 后 ,外 力 大 小 再 次 达到 阐 值 且 持 续 时 间 达 到 预定 时 间 时 ,在 前 次 ID 的 基础 上 再 次 增 
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加 预 设 的 数值 。 
[0057] ”所 述 系 统 还 包括 : 

预 设 模块 ,用 于 预 设 一 初始 ID; 初始 ID 在 每 次 接收 到 ID 设置 指令 时 被 调用 。 
[0058] ”所 述 系统 还 包括 : 

提示 模块 ,用 于 在 舵 机 ID 发 生变 化 时 ,发 出 提示 。 
[0059] ”本 申请 所 述 系统 中 ,由 于 其 各 模块 本 身 的 功能 及 彼此 之 间 的 逻辑 连接 ,能 实现 前 
述 实施 例 的 各 个 步骤 ,因此 能 够 达到 与 前 述 实 施 例 相同 的 技术 效果 ,原理 分 析 可 参见 前 述 
方法 步骤 的 相关 描述 ,在 此 不 再 累 述 。 
[0060] ”本 申请 男 一 实施 例 , 公 开 了 一 种 舵 机 1D 设置 设备 ,其 中 ,包括 存储 器 和 处 理 器 ,所 
述 存储 器 存储 有 计算 机 程序 ,计算 机 程序 能 够 被 加 载 并 执行 ,实现 如 下 所 述 步 又 : 

实时 获取 各 个 艇 机 受到 的 外 力 大 小 ; 
基于 舵 机 受到 的 外 力 大 小 ,在 外 力 达 到 阔 值 且 持 续 时 间 达 到 预定 时 间 时 ,将 对 应 
能 机 的 ID 在 初始 ID 的 基础 上 增加 预 设 的 数值 ; 
基于 同一 个 能 机 ,在 舵 机 的 ID 基于 初始 ID 的 基础 上 增加 预 设 的 数值 后 ,外力 大 小 
再 次 达到 阔 值 且 持 续 时 间 达 到 预定 时 间 时 ,在 前 次 ID 的 基础 上 再 次 增加 预 设 的 数值 ; 
基于 同一 个 舵 机 ,在 舵 机 的 ID 基于 初始 ID 的 基础 上 增加 预 设 的 数值 后 ,外 力 大 小 
再 次 达到 阔 值 县 持续 时 间 达 到 预定 时 间 时 ,在 前 次 ID 的 基础 上 再 次 增加 预 设 的 数值 。 
[0061] “接收 JD 设 置 指令 ,控制 各 个 艇 机 进入 初始 化 状态 的 步骤 包括 ; 
调节 各 个 舵 机 的 位 置 以 及 相对 位 置 关 系 。 
[0062] ”接收 ID 设置 指令 ,控制 各 个 舵 机 进入 初始 化 状态 的 步骤 之 前 还 包括 ; 

预 设 一 初始 ID; 初 始 ID 在 每 次 接收 到 ID 设 置 指令 时 被 调用 。 
[0063] ”所 述 方 法 还 包括 : 

在 艇 机 ID 发 生变 化 时 ,发 出 提示 。 
[0064] ”由 于 设备 中 的 存储 器 中 存储 的 计算 机 程序 在 处 理 器 上 运行 后 ,会 实现 前 述 实 施 例 
的 各 个 步骤 ,因此 能 够 达到 与 前 述 实施 例 相 同 的 技术 效果 ,原理 分 析 可 参见 前 述 方法 步 又 
的 相关 描述 ,在 此 不 再 累 述 。 
[0065] ”本 申请 男 一 实施 例 , 公 开 了 一 种 存储 介质 ,其 中 ,存储 有 计算 机 程序 ,计算 机 程序 
能 够 被 处 理 器 加 载 并 执行 ,实现 如 下 步骤 : 

实时 获取 各 个 能 机 受到 的 外 力 大 小 ; 
基于 能 机 受到 的 外 力 大 小 ,在 外 力 达 到 闪 值 且 持 续 时 间 达 到 预定 时 间 时 ,将 对 应 
能 机 的 ID 在 初始 ID 的 基础 上 增加 预 设 的 数值 ; 
基于 同一 个 舵 机 ,在 舵 机 的 ID 基于 初始 ID 的 基础 上 增加 预 设 的 数值 后 ,外 力 大 小 
再 次 达到 阔 值 且 持 续 时 间 达 到 预定 时 间 时 ,在 前 次 ID 的 基础 上 再 次 增加 预 设 的 数值 ; 
基于 同一 个 能 机 ,在 舵 机 的 ID 基于 初始 ID 的 基础 上 增加 预 设 的 数值 后 , 外 力 大 小 
再 次 达到 阔 值 县 持续 时 间 达 到 预定 时 间 时 ,在 前 次 ID 的 基础 上 再 次 增加 预 设 的 数值 。 
[0066] ”接收 ID 设置 指令 ,控制 各 个 艇 机 进入 初始 化 状态 的 步骤 包括 ; 

调节 各 个 舵 机 的 位 置 以 及 相对 位 置 关 系 。 
[0067] ”接收 ID 设置 指令 ,控制 各 个 舵 机 进入 初始 化 状态 的 步骤 之 前 还 包括 : 

预 设 一 初始 ID; 初始 ID 在 每 次 接收 到 ID 设置 指令 时 被 调用 。 
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[0068] ”所 述 方法 还 包括 : 

在 舵 机 ID 发 生变 化 时 ,发 出 提示 。 
[0069] ”由 于 存储 器 中 的 计算 机 程序 在 处 理 器 上 运行 后 ,会 实现 前 述 实施 例 的 各 个 步骤 ， 
因此 能 够 达到 与 前 述 实 施 例 相同 的 技术 效果 ,原理 分 析 可 参见 前 述 方法 步骤 的 相关 描述 ， 
在 此 不 再 累 述 。 
[0070] ”本 说 明 书 中 各 个 实施 例 采用 弟 进 的 方式 描述 ,每 个 实施 例 重点 说 明 的 都 是 与 其 它 
实施 例 的 不 同 之 处 ,各 个 实施 例 之 间 相 同 或 相似 部 分 互相 参见 即 可 。 
[0071] ”专业 人 员 还 可 以 进一步 意识 到 ,结合 本 文中 所 公开 的 实施 例 描述 的 各 示例 的 单元 
及 算法 步骤 ,能 够 以 电子 硬件 、. 计 算 机 软件 或 者 二 者 的 结合 来 实现 ,为 了 清楚 地 说 明 硬件 和 
软件 的 可 互 换 性 ,在 上 述说 明 中 已 经 按照 功能 一 般 性 地 描述 了 各 示例 的 组 成 及 步 又。 这 些 
功能 究竟 以 硬件 还 是 软件 方式 来 执行 ,取决 于 技术 方案 的 特定 应 用 和 设计 约束 条 件 。 专 业 
技术 人 员 可 以 对 每 个 特定 的 应 用 来 使 用 不 同方 法 来 实现 所 描述 的 功能 ,但 是 这 种 实现 不 应 
认为 超出 本 申请 的 范围 。 
[0072] ”结合 本 文中 所 公开 的 实施 例 描 述 的 方法 或 算法 的 步骤 可 以 直接 用 硬件 、 处 理 器 执 
行 的 软件 模块 ,或 者 二 者 的 结合 来 实施 ,软件 模块 可 以 置 于 随机 存储 器 (RAW 、 内 存 、 只 读 存 
储 器 ROW 、 电 可 编程 ROM、 电 可 擦 除 可 编程 ROM、 寄 存 器 、 硬 盘 、 可 移动 磁盘 、CD-ROM. 或 技术 
领域 内 所 公 知 的 任意 其 它 形式 的 存储 介质 中 。 
[0073] ”本 具体 实施 方式 的 实施 例 均 为 本 申请 的 较 佳 实施 例 ,并 非 依 此 限制 本 申请 的 保护 
范围 , 故 ; 凡 依 本 申请 的 结构 、 原 理 所 做 的 等 效 变 化 , 均 应 涵盖 于 本 申请 的 保护 范围 之 内 。 
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接收 ID 设置 指令 ， 控 制 各 个 能 机 进入 初 
始 化 状态 


实时 获取 各 个 能 机 受到 的 外 力 大 小 


基于 能 机 受到 的 外 力 大 小 ， 在 外 力 达 到 
靖 值 且 持 续 时 间 达 到 预定 时 间 时 ， 将 对 


应 艇 机 的 ID 在 初始 ID 的 基础 上 增加 预 设 
的 数值 


基于 同一 个 舵 机 ， 在 艇 机 的 ID 基 于 初始 
ID 的 基础 上 增加 预 设 的 数值 后 ， 外 力 大 
小 再 次 达到 立信 且 持 续 时 间 达 到 预定 时 
间 时 ， 在 前 次 ID 的 基础 上 再 次 增加 预 设 
的 数值 


图 1 
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torque rate /% 100 
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angle offset / ° 


图 3 


32 


